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(54) Robot controller 

(57) A robot controller which controls a process con- 
trolled variable of an operational tool mounted on a robot 
in synchronism with the robot motion. The position of 
each axis of the robot is detected by a sensor such as 
a position detector In a calculating section, motion var- 
iables such as position P^, velocity v^ and acceleration 
Op of a tool center point (TCP) are detected from the 
respective positions of the robot axes. An ideal output 
(target value) of a sensor for detecting a controlled var- 
iable to be controlled in accordance with, the motion 



state is determined in a calculating section. A sensor 
output is subtracted from the target value to determine 
a deviation. The deviation is multiplied by a proportional 
gain K to determine a manipulated variable. By using 
this manipulated variable, the process of an arc welding 
machine, sealing machine, or laser beam machine in 
which a tool is mounted on a distal end of a robot wrist 
is controlled. The target value is determined in accord- 
ance with the change of motion state of the robot, and 
feedback control is carried out so as to follow the target 
value so that uniform operation is achieved. 
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when peripheral equipment is an arc welding machine; 

FIG. 3 is a block diagram of a process control section in accordance with one embodiment of the present invention 
when peripheral equipment is a sealing machine or a painting machine; 

FIG. 4 is a block diagram of a process control section in accordance with one embodiment of the present invention 
s when peripheral equipment Is a laser beam machine; 

FIG. 5 is a block diagram of a robot controller in the embodiment; 

FIG. 6 is a flowchart for process control processing for peripheral equipment executed by a main processor of a 
robot controller in the embodiment; 

FIG. 7 is a flowchart for processing in a process control section when the peripheral equipment is an arc welding; 
10 FIG. 8 is a flowchart for processing in a process control section when the peripheral equipment is a sealing machine 

or a painting machine; and 

FIG. 9 is a flowchart for processing in a process control section when the peripheral equipment is a laser beam 
machine. 



IS [0013] FIG. 1 is a schematic diagram for explaining an operational principle of the present invention. In the present 
invention, the positions on robot axes are determined by various internal and external sensors of the robot, and a 
position Pn, a velocity v^ and an acceleration of a TCP (tool center point; robot control point which Is set at a center 
point of an end effector) are determined in a calculating section 2 based on the respective axes positions, and trans- 
ferred to a process control loop 3 tor controlling the process of an operational tool mounted on a distal end of a robot 

20 wrist. 

[0014] In the process control loop 3, an Ideal state of output of a sensor for detecting a controlled variable of a 
controlled object is determined in a sensor output ideal-state calculating section 3a. which constitutes supply control 
means, based on the position P^, velocity v„ and acceleration of the TCP as motion variables of the operational 
tool. In other words, a target value, which is an ideal value of the controlled variable detected by the sensor, is deter- 

25 mined. Then, a deviation between the value in the ideal state (target value) and an actual value of the controlled variable 
detected by the sensor is obtained, and the deviation is multiplied by a proportional constant K (element 3b) to determine 
the manipulated variable, which is used as a control input for a process (3c) of the controlled object. 
[0015] The above is a description of the principle of synchronous operation of the peripheral equipment with the 
robot in which the tool (peripheral equipment) mounted on the distal end of the robot requires process control In syn- 

30 chronism with the robot motion. 

[0016] FIG. 5 is a block diagram of an essential portion of a robot controller for controlling the above-described 
peripheral equipment (tool) requiring the process control. A main processor 1, a memory 2 consisting of RAM. ROM, 
and nonvolatile memory (EEPROM etc.). an interface 3 for teaching operation panel, an interface 6 for external devices, 
and a servo control section 5 are connected to a bus 7. A teaching operation panel 4 Is connected to the interface 3 

35 for teaching operation panel. 

[001 7] A system program for supporting the basic functions of the robot and the robot controller Is stored in the ROM 
of the memory 2. Also, a robot operation program taught for an specific application and associated set data is stored 
in the nonvolatile memory of the memory 2. The RAM of the memory 2 is used for temporary storage of data in various 
kinds of calculation processing performed by the processor 1. 

40 [001 8] The servo control section 5 has servo controllers S^i to S^^ (n: total number of robot axes, including the number 
of operational axes set to the tool mounted on the distal end of the robot wrist). Each of the servo controllers to 
5^ is composed of a processor, ROM, RAM, etc. to carry out position and speed loop control of a servomotor for driving 
each axis and further to carry out current loop control. The servo controller consists of a so-called digital servo controller 
which carries out loop control of position, speed and current by means of software. The output of the servo controller 

^ to controls the servomotor Ml to Mn for each axis through a servo amplifier to S^n. Although not shown in 

the figure, each of the servomotors M1 to Mn Is provided with a position/speed detector so that the position and speed 
of each servomotor detected by the position/speed detector is fed back to each of the servo controllers 5^^ to 5^. Also, 
the input/output Interface 6 is connected with sensors provided on the robot and actuators and sensors of the peripheral 
equipment. ' 

so [0019] According to the present invention, process control for the processing shown In FIG. 1 is carried out by the 
robot controller having the above-described hardware constitution, with respect to the tool (peripheral equipment) 
mounted on the distal end of the robot wrist and requiring the process control In the peripheral equipments connected 
to the input/output interface 6. 

[0020] FIG. 6 Is a flowchart of processing, as shown In the schematic diagram of FIG. 1 showing the principle of 
55 operatbnal. to be executed by the main processor 1 of the robot controller for each predetermined period to determine 
the manipulated variable to be outputted to the peripheral equipment requiring the process control. 
[0021] First, an absolute position is read from a position detector for detecting the position on each axis of the robot, 
which is an internal sensor of the robot (Step SI ). Based on the read axes position, generally called forward conversion 
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be increased. This means that the power of energy applied for welding must be changed in proportion to tool center 
point velocity v^. Takingihe power of applied energy as E, the welding current as I. and the resistance from the welding 
torch tip (tool tip) to a weld point of the object to be welded as R, E = Rl^ In order for the weld bead to be always kept 
constant even if the velocity v of the welding torch tip (tool center point) changes, the relationship expressed by the 
5 following equation (1 ) has only to hold. 

E = RI^ = K1-v^ (1) 

10 where, K1 is a proportional constant. From Eq. (1 ), the target value 1^^^ of the welding current I, which is the controlled 
variable, is expressed as 

icmd = (K1VR)'^ " (2) 

IS 

[0030] Also, since the resistance R from the welding torch tip to a weld point of the object to be welded Is proportional 
to the distance between them, the resistance R is expressed as 



2Q R = K2-(distance between welding torch tip and object) (3) 

[0031] Thereupon, the target value l^^d welding current can be determined from the above equations (2) and 

(3). 

[0032] FIG. 7 is an essential portion of a flowchart for processing in each predetermined period of the main processor 
^5 1 which controls the welding current of the arc wejding machine, which is the peripheral equipment. 

[0033] In the processing for controlling the welding current of the arc welding machine, the processing In Step S6 is 
executed after the processing from Step SI to Step S5 in FIG. 6 has been performed. In the control of the arc welding 
machine, the processing in Step S6 is replaced by the processing in Steps S6a1 , S6a2 and S6a3 in FIG. 7, the process- 
ing in Step 7 is replaced by the processing in Step S7a. .and the processing in Step S8 is replaced by the processing 
30 in Step SBa. 

[0034] After the processing in Steps S1 to S5 is executed to determine the TCP position P^, velocity v^. and accel- 
eration On in the present period, a robot motion command is first read by means of the taught operational program, 
and a commanded position Pp of TCP is determined by forward conversion (Step S6a1 ). If the taught operational 
program has been produced at the TCP position Pp on the reference orthogonal coordinate system, the processing of 

55 forward conversion need not be performed, and the read data is data of the TCP position Pp. 

[0035] Next, a size Gp of a gap between the TCP and a weld point position is determined from the commanded value 
Pp of TCP position and the present position P^. Specifically, the size G^ of a gap between the weld torch tip position 
and the weld point position is determined. In this embodiment, a weld line of the object lies on the X-Y plane on the 
reference orthogonal coordinate system, and the welding torch is disposed in the plus direction of Z axis above the 

^0 plane on which the weld line of the object lies, so that a position which is apart from the welding torch tip (TCP) by a 
predetermined gap size Gq rn the plus direction of Z axis is taught as the weld line. Therefore, the size G^ of the gap 
in the present period is determined as follows: The position Pp commanded by the taught operational program is 
subtracted from the present position P^ of TCP to determine a position deviation between the present position P^ and 
the position Pp commanded by the taught operational program, and the size Gg of the gap at the time of teaching is 

45 added to this position deviation (Step S6a2). 

Gn = P„-Pp + Go (4) 

[0036] By using the gap G^ thus obtained, the processing of Eq. (3) is performed to determine the resistance R, and 
further the processing of Eq. (2) is performed to determine the commanded current l^rnd ^® target welding current 
(Step S6a3). The measured value 1^ of welding current fed back from the welding machine is read via the input/output 
interface 6 (Step S7a). and a value obtained by subtracting the fed back current If from the commanded current 
is multiplied by the proportional gain K to obtain the voltage command V^^j (= K-O^^nd ' 'f)) srs^ 9^® welding 
^ machine (Step S8a). Thereby, the processing in the present process period is completed. Subsequently, for each 
period, the processing in Steps SI to S5 in FIG. 6 and Steps S6a1, S6a2, S6a3, S7a and S8a in FIG. 7 is executed 
to change the welding current of the welding machine according to the movement velocity of the welding torch (tool). 
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where, k1 , k2 and K1 are constants. 
[0043] It the driving current I of the laser oscillator is changed according to the velocity v^ of the laser beann machining 
head so that the above equation (6) holds, the energy applied per unit movement distance is made unifonn even if the 
velocity changes, so that laser machining of uniform quality can be achieved. 

5 [0044] FIG. 4 is a block diagram of the process control section 3 for a laser beam machine. In the sensor output 
ideal state calculating section 3Ca of the laser beam machine, a target current command 1,^^^ is determined by per- 
forming the calculation in Eq. (6) using the tool center point velocity (movement velocity of nozzle tip of the laser beam 
machining head). A fed back value If of driving current of the laser oscillator, which is detected by a sensor, is subtracted 
from the target current command Icmd determine the current deviation. This current deviation is multiplied by the 

10 proportional gain K (element 3Cb) to determine a voltage command (manipulated variable) V^^^j of the laser oscillator, 
and the laser oscillator 3 Cc Is driven by this voltage comnnand V^.^. 

[0045] FIG. 9 is a flowchart for processing executed in place of Steps S6, S7 and S8 in FIG. 6 in the case where the 
peripheral equipment to be process controlled is a laser beam machine. 

[0046] The main processor 1 of the robot controller performs the processing in Steps 81 to 85 shown in FIG. 6 to 

75 determine the velocity v^ of nozzle tip of the laser beam machine, and performs the calculation of Eq. (6) using this 
velocity to determine the target current command (Step SSc). Then, a value obtained by subtracting the fed back 
value If of a measured value of driving current of the laser oscillator, which is measured by a sensor, from the target 
current command is multiplied by the proportional gain K to determine the voltage command V^j^^j (= K-(lg^jj • If)) 
to the laser oscillator as the manipulated variable, and the voltage command Vg^j^ is given to the laser oscillator via 

20 the external input/output interface 6 (Steps S7c and SSc). 

[0047] Subsequently, the processing in Steps S1 to S5 and Steps S6c, S7c and S8c is executed for each predeter- 
mined period. The target commanded current 1^^^ is changed according to the movement velocity of the laser beam 
machining head, and feedback control is carried out so that the driving current value of the laser oscillator, which is 
detected by the sensor, agrees with the target commanded current 1^^^. Therefore, even if the movement velocity of 

25 the laser beam machining head changes, energy per unit movement distance applied by the laser beam machine is 
made constant, so that laser beam machining such as cutting of uniform quality can be achieved. 
[0048] In the peripheral equipment which applies a substance or energy to an object through the operational tool 
mounted on the distal end of the robot wrist, even if the state of robot changes, the robot controller carries out the 
process control for applying the substance or energy according to the change, so that the substance or energy can 

30 always be applied uniformly. Thereby, machining of high quality can be achieved. 



Claims 

35 1 . A robot controller comprising: 

motion control means for moving an operational tool mounted on a robot with respect to an object; 
supply means for supplying energy to be applied to the object through said operational tool; 
supply control means for issuing a supply comnnand to said supply means, said supply command being de- 
40 termined based on motion variable of said operational tool in motion obtained by said motion control means; 

and 

means for feeding back a parameter representing power of said energy supplied through said operational tool 
to alter said supply command based on the fed back parameter. 

45 2. A robot controller for. arc welding operation according to claim 1 , wherein said motion variable is speed of a control 
point of the robot relative to the object, said supply means is power source for supplying welding current and said 
parameter is the welding current. 

3. A robot controller for laser welding operation according to claim 1 , wherein said operational variable is speed of a 
50 control point of the robot with respect to the object, said supplying means Is a laser oscillator for supplying laser 

beam and said parameter is excitation current of said laser oscillator, 

4. A robot controller for controlling a robot comprising: 

55 motion control means for moving an operational tool with respect to an object; 

supply means for supplying energy to an operational substance to be fused so as to apply the fused operational 
substance to the object through said operational tool; 

supply control means for issuing a supply command to said supply means, said supply command being de- 



7 



BNSOOCID: <£P_10S864QA2UI_> 



EP 1 038 640 A2 



POSITION. 
VELOCITY. AND 
ACCELERATION OF 
TCP 



INTERNAL 
AND 

EXTERNAL 
SENSORS 
OF ROBOT 




1 


i 



CALCULATING 
SECTION FOR 
POSITION. 
VELOCITY AND 
ACCELERATION 
OF TCP 



POSITIONS OF 
RESPECTIVE AXES 



FI6. 1 



P n 






— > 


V n 






— ► 


or n 






— > 



.3 a 



CALCUUTING 
SECTION FOR 

SENSOR 
OUTPUT IDEAL 

STATE 




SENSOR FEEDBACK 



FIG.2 



3 A 



TCP 
VELOCITY 



3 A a 



R = K2 'DISTANCE FROM PLATE 
I cmd =V CKl • v/RJ 



3 A b 



] cad 



K) ► K 



3 Ac 



WEL0IN6 
POWER 
SOURCE 



VOLTAGE COMMAND Vcmd 



WELDING CURRENT FEED BACK I f 



BNSOOaO: <£P_1038840A2J_^ 



9 



EP 1 038 640 A2 



FIG.5 



4 



TEACHING 
OPERATION 
PANEL I/F 




G> a- 

Ml M2 



EXTERNAL 
INPUT/OUTPUT 
1 /F 



JLJLJLAJLJLJLJLA. 



Mn 



BNSOCX:iD: <EP_103864QA2J_> 



11 



EP 1 038 640 A2 



FIG. 7 



PROCESSING UP TO STEP S5 IN 
FIG. 6 



S 6a1 



S 6a2 



S 6a3 



S 7 a 



S 8 a 







CALCUUTE COMMANDED 
POSITION Pp OF TCP 
FROM MOTION COMMAND OF 
ROBOT BY FORWARD CONVERSION 






CALCULATE SIZE OF 6AP 6 
G= (Pn-Pp+Go) 






R=K2 • G 


I and =y (K 1 • vn/R) 






MEASURE FED BACK CURRENT 
I f OF WELDING MACHINE 






VOLTAGE COMMAND V and TO 

WELDING MACHINE 
Vcind=K' (I and- If) 







BNSOOQD: <EP_ia38S4QA9.l^ 



13 



(19) 



J 



Europaisches Patentamt 
European Patent Office 
Office europeen des brevets 



(12) 



(11) EP 1 038 640 A3 

EUROPEAN PATENT APPLICATION 



(88) Date of publication A3: 

29.01.2003 Bulletin 2003/05 

(43) Date of publication A2: 

27.09.2000 Bulletin 2000/39 

(21) Application number 99310609.5 

(22) Date of filing: 24.12.1999 



(51) intciT: B25J 9/16, G05B 19/19. 
G05B 19/425 



(84) Designated Contracting States: 


(72) Inventors: 


AT BE CH CY DE DK ES Fl FR GB GR IE IT LI LU 


• Watanabe, Atsushi 


MC NL PTSE 


Tokyo 168-0072 (JP) 


Designated Extension States: 


• Kato, TetsuakI 


AL LT LV MK RO SI 


Hadano-shi, 259-1322 (JP) 


(30) Priority: 25.03.1999 JP 8190999 


(74) Representative: Billington, Lawrence Emiyn et al 




Haseltine Lake & Co. 


(71) Applicant: FANUC LTD. 


Imperial House 


Minamitsuru-gun, Yamanashi 401-05 (JP) 


15-19 Kingsway 




London WC2B 6UD (GB) 



(54) Robot controller 

(57)* A robot controller which controls a process con- 
trolled variable of an operational tool mounted on a robot 
in synchronism with the robot motion. The position of 
each axis of the robot is detected by a sensor such as 
a position detector. In a calculating section, motion var- 
iables such as position velocity v^ and acceleration 
ttp of a tool center point (TCP) are detected from the 
respective positions of the robot axes. An ideal output 
(target value) of a sensor for detecting a controlled var- 
iable to be controlled In accordance with the motion 



state is determined in a calculating section. A sensor 
output is subtracted from the target value to determine 
a deviation. The deviation is multiplied by a proportional 
gain K to determine a manipulated variable. By using 
this manipulated variable, the process of an arc welding 
machine, sealing machine, or laser beam machine in 
which a tool is mounted on a distal end of a robot wrist 
is controlled. The target value is detemriined in accord- 
ance with the change of motion state of the robot, and 
feedback control is carried but so as to follow the target 
value so that uniform operation is achieved. 
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